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(54) GaH genersllon system of t^sgea mobile rctoci 

(57) A gait gesieration system of a biped , RiOKie 
rdx3t (1) having a tsody (24) snd two articutated fegs (2) 
each having s foot si its dista) end connected by an *^ 
ankie joitts {10,12,14B,L). The system has two or three 
modiete approximating a deviaiio« oi dtepiacement 
^positfoo) and vslocfty oi the body and the 2MP {zero 
mcMTtsnt pojrt.) indtcatwe of the floor reactfon force acl- 
ins on the robot, irt «» system, two gaits for a robot 
walking step are geterated. If fltere is a tifecorrSnuity of 
the body posittor; or velocity or the 2MP in fl» gait 
ijQitndary. the modeis ere manipttfated to canc^ tti9 die- 
con^ni^y. Hvs ou^ of the mod^s are cedcuiated fi«m 
the input and based on the it^t and oulpot. the gaits 
are corrected. The mod^ are designed to stop at every 
two >«ffiitktRg $tt^ so as to avoid calcuisrtion enor$ from 
being aeounii^aieo. 
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iht ssit generation system sooor dbg to the present inveolion; 

Figwfe 4 fe an exptanatery view showing a dynamic deviation mocJet approximating ihebehavksrof the fobot that is 
M&ed in the system sccwdiivg to fte present inverttioi; 

Ftfiture 5 is corrposed of time charts stowing the gsSt discontinui^ mat occurs during the gait genemtion and the 
techrticjoe to solve the prol^efn used in gie system accoedtng to the present invertion; 

Rguf e 6 is conposeef of time charts, simifar to Figure 5. but lowing that the prdslem is easify sotved by the tech- 
nique used in the system seconding to the inverttion, without consdemSion ot the 2MP shitting: 
Fsgyre 7 is composed of tsme charts nwe specif icafiy shewing the technique used in the system; 
Figure s is a time chart showing an accumutation of caicola^on errors when caicuteting the behavior of the model 
shown in Figure 4: 

Figure S is an expfenatory wiew ^ovWng the cortfiguraljon of the system according to the present invention in which 
t¥Wj escanptes of the inodel itetratefj irt Fsgyre 4 are provided 10 preswit the cateidafion errors from fo^ng accumu- 
lated: 

Bgure 10 is composed titm charts showing the behswior of the two models ilfoslrated m Figore 9 to prevent fie 
calculation errors from being accumulated; 

Figure 1 1 1s an esqsianatwy plan view showing tie position and orientalion of the robot feet in standard gai! Mo. 0 
among the standard gaits used in system accotdttig to the present invention; 

Figure 12 is m expianafory side view showing the trajectory of fte feet in standard gait Mo 0 aiwstrated in Figure 

11; 

Figure 12 is a «me char! showing the trajectory of the 2MP {Zero Monrent Point) to the X-direcfion in standard gait 
No, 0 iflustrated in Ftgure 1 1 ; 

Figure 14 is an ex|^anatory plan view showing the posifiors and orientation of the feet if! standard gait No. 1 antong 
the standard gaits used to the system according to the pr«er« InvenSon; 

Figure 15 is a Sme chart showog the ftajectory of the 2m* m the X-direction tr> standard gait No. 1 iustrsted in 

Figure 14; 

Figure 1 6 is m explanatory plan view showing »ie pesiSoo and wientaSion of the feet »n stendard gait Ho. 2 amcwtg 
the standard gaits used in the system accottttog so the present invention; 

Figure 17 is a time chart showing the trajectory of ttw mc m the X-dlfecfi«i in standard gait No. 2 Sitstrated in 

Figure 16; 

Figure ie is a view, sirrrilar to Figure 1 1 , but showir^ the dermnded p<»t1ton emd or istitatlon ot the feet referred to 
in the system according to the present invention; 

Figure IS is a view, smiiar to Figure 13, but showing trajectory of the ZMP for the demanded gait retired to in 
the system according to the j»-e&ent invention: 

Figure 20 is a main flow chart Rawing the operaSon of the system according to the present invenljon iBustmtsd in 
Figure 3; 

Figure 21 is a Sme chart showing the charatSeristics ot the behavior ot the mode) iHiratfated In figure 4 deye!<qjed 
in response to a unit amoont of 2MP Bhifting (bias) in the tst gait (current gaif); 

Figure 22 is a view, simiiar to Figure 2 1 , but showing the characteristics of the behawof <^ the rttedel dev^ed in 

respofTse to the unit anvount o! ZMP shifting (bias) In 2od gatt {nea« gait); 

Figure £3 is ft view, stmiiat !o Figure ST. txit showsng the oharactwistics of the model behavior developed in 
resjoonse to a unit amount of ZMP shiftir^ (tsas); 

Figure 24 is a view, sin^r to Figure £3. but showing the charactsrlsiics of me model behavior developed in 
rei^xmse to a unri amount of model position skipping; 

Figure 25 is a view, similar to Ftgwe 24. but showing the characteristics of *»e model behawiof developed in 

response to a unit antount of model velocity slsf^Ptg; 

Figure £6 is a subroutine Ifow chart Of the f tow Chart Illustrated in Figure 20 showing the procedures perfetwefii at 

the 6me of q&H switching; 

Figure 2? is B subroutine flow chart of the f tow chart tfcstrated m F(gofe26 shewing tie determinatiw of tte rrxxis! 

trajectory parameter and the model ZMP parameter; 

Figure 28 is a suiaroutine f!ow chart of the flow chart ius!raf«:j in Figure 20 showing the cafctrfation of Instantane- 
ous vaiues in a generated mixed gait; 

Figure 29 is a time chart explaining the calcufation ot a current instantaneous vaSue of the model ZtViP referred to 
in tte flow chart of Figure 20; 

Figure 30 is a view, similar to Figure 9. but showing the configuration of the system accordins to a secortf embod- 
iment of the presert invention in kvhich three examples of the model illustrated m Figure 4 are provided fa prevent 
the cslGuiation errors tram being acoumuiated; and 

Figure 35 is a view, simitar to Figure 10, taut ^lowirjg the behavior of the three models iiiustrated in Figure 30 to 
prevent Sre cafcuiation erro-'s from besr^ aecumulated tri the system according to the second entjodiment of tie 
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present invertfion. 
DETAILED OeSCRiPTiON OF THE PREFERRED EMBODIMENTS 

Errftiodimente oi the irwenfion witi now be expfained iaWog a b^ed mobi!e rcisoi as ihe exanipfe of the fegged 

fJKibile robot. 

Figure 1 is an overall schsmafio vvm showing the systenn for genefiating a gmt oJ a ieggsd mobite rcAiot according 

to Sie present inverrtiort. 

As lliustrated in me fiQure, the robot 1 has a pair cf ialeraliy spaced articulated isgs fieg iinks) 2 ea* composed oi 
six Joints, Fof an easier understanding, each of the joints is reor&s«nied by an etecific motof which actuates the joint. 
The joints Inciude, arrariged sMcc^iveiy dowfVwaRl, a pair of joints lOR, ?0L r^Wsand jwnt is itwSicated by R afjcf 
the ieft-hand joSm by I) tor rotating fegs with respect to a hip, a pair of jtsnts 1 2R, 1 2L t<y pitohing movement w«th respect 
to the hip about a Y-a«s wSthin a sae^tte! ptiane, a pair of joints UR, 14L for fotli«g movemerrt with r«sped to *e 
iaboutan X-wtswiihfnaffontalsrfwie. ap^rof kneejo'nts IBB. 16L for pitehing movement with respect to ioiees. a pair 
of joints 18R, 18L tor fstching movement with rgspect to feet ^R{i). and a pair of joints 20R{L) for roSing movemenf 
with respect to feet 22R(l), 

The f(±>ot 1 has a ixjdy (trur*} 24 as iis uppermost portion which houses therein a contro! unit 26 oomprising micro- 
conputere «*iich vwH be described fater with reference to Figure 2. The joints 1 0R(L) , 12R(L), 14R(L) make up hip joints, 
arKt the Joints 18R(L), 20R(L} rnake up ankie joints T>ie htp joints mti kme joints are connected to each other by thigh 
Bnte 28R, 28L, anc! the Knee joints and artkte lotrts aie conneded lo each other by crus or shank iini^s 30R, SOL. With 
the structure, eacii of the legs 2 m given six degrees of treeciom. When the 6 x 2 « 12 joints are driven to suitaHs 
angles whsie the robot 1 is wstfWng, a desired motion is (tr^rted to ihe entire leg sfriictiife to cause the two-legged 
waiking robot 1 to walk arbitrarjiy in a three-dtmensionaf enwironmenj including stairs 

ft miuki be noted Siat. throughout the deso-flstion, the position (tiispJacement) and (disj^cement) vsiodty of tte 
body 24 i$ used to mean those of a repfesenta^ve positi wj such as the position of the center of gravity of the body 24 
and (di^acetnent) velocity thereof. 

A Known six-aws force and torque sensor 44 is disposed befow the ankfe joint 1 8, 20R{L) for nwawnng three dfrec- 
tionat componenrts Fx, Fy, fz oi force and three direclicmi components Mx, My> Mr of totque or n»mert thereby to 
detect whether the foot 2£R(L} has latided a' not, or if a ioad or force is acting on the rotjot through frie foot assemfoiy 
when it contacts the floor. The body 24 has an inclination sensof 60 Ux detecting tw^ng or incttrtstion in the ffonlat 
plane with reject to a 2-axis (the direction of ^avily) and its angMtar velocity, and also a tilt in the sagittal plane with 
re^ct to the z-axis and its angular vetadiy The electric motors of «w respective Joints are coi;p!ed with respective 
rotary encoders for detecting aogufar displacements of the elecfrjc tnotors, and thweby the Joint angles, 

Aithoygh not shown in Figure 1, Bie robot 1 is configured to have a joystie* at an ap^priate position thereof, 
through which an operator can stpiit a demand for *e gait to change to another gait sudi as making *e robot, when 
washing straight, to turn, it is atternstivety pt^&te to iwovide, instead of the joy«tK3<, a remote ooofeol system or com- 
munication system for the santre purpose. 

Figure 2 is a block diagram v*!Ch shows the d^aits of t>e control uwt 2S, which Is cotrprised erf microcon^utefs. 
Output signals from the sensors 44 and the inclinat^n sensa 60 as well as the joysiick (assigned with reference 
numeral 62 in the figure) are oonverJed by an A/0 converter 70 into digital signals, which are transmitted through a bus 
72 to a RAM 74. Output signals from tie rotary encoders that are disposed adjacent to m rss$)ecttve eiscfric mcmn 
are ttansrrttted through a counter 7S io the RAM 74. 

The contfoi unit 26 includes first and second CPlte 80, SS, The first CPU 80 genemtes a gait freefy m a re^-time 
basis during vsratking using standard gaits prepared beforehand and stored in a ROM 84, calatliaeH commands *;» 
joint angles fciased on the generated gait, and ou^irts the commands to the RAM 74, The second CPU 82 reads t)e 
commands and delected vatues f ran the RAM 74, and outputs manipulated variabies tfwo«gh a D/A corwerter 8S mi 
servo-ampfff iers to the electric motors provided at the respective joints. 

Figure 3 is a btocK diagram which m^ws the conf iguraSw and mode of operatfor* of the system aocoidifHJ fo t)e 
present invention in a software manner. 

For ease of understanding, *e gait generation proposed in the Miriier application 8 {I996i - 214.261) is 
desaibed briefly. 

The eat1i«i)n3posed tetdmique is based on the conrpfiance control rnenSoned in another ^tcation proposed by 
the af^flicanf which ««as patett^f in the United Slates under «ie number of S,432.417, 

In the comphance ccsitroi. the error between a desired position and the delected position of «ie ca*a! pant of the 
floor reaction force actjng on tie robot is first determined, and eith«- cm both of ttie fegs are moved to decrease »te error, 
therebv eff'?c«irig control ot [Xssture stability ^'Wien the robot is about to tip over, the deetred ftoor reaction force poafiton 
!S intentionaiiy moved oi shifted so as to restore fc*ot posture stabifiiy, Tlie earlier -proposed a^tcation {Hei 8 {1896) 
■ 2 i 4,261 j armed to generate a gait necessary for conducting the robot posture stabilization o^ng such a larKf of com- 
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ptisnce OJntro!. 

in !t)bcJ locofTOtion confrol, it is inipossWe to ensure stable v«a!htng or tocomotion uoiess Ihe retaticm^ips among 
the desirKi nxition ttajecioi ies and the desired ffwr r«8C«on force patJern saBsfy the dynamic equifiijwi ecsxiiiion. To 
saiisfy the dynamic sqaslibrium corKjttior> means, to fafe m«e speafic. Vtnt the centraf point oi the desiied floor reaction 
5 force ithe point of actiorj on tie fioor aS which the secondary mcxneriS of Ihe desired floor reaciion force becomes aero) 
is equajtothe Zero Moment Point {the pointoriftjeffoocat which the moment oi the resuitatittace of tite liiefbai force 
due to rrrafjoft and gravity is sero except tor its vertical component; referred to hereiriafler sfmpiy a& ZMP) if they do not 
accord wifi each other, the robot loses the d>T>amic eqoiiibrium betwesr^ the resultant force and the f ioof reaction force 
and wilt tip over or rotate, 

10 in Ihe conpl(anc« contro! proposed earfier, this rotation is deiioeratsiy utilized to restore stability wher; the robot is 
atxiut to tip Of turn over. At any rate, the robot gait should indude rtol oniy the desired fnaion patterns or traieclories, 
but ateo the dssirsd fioor reaction ferce patterns wrtiitJi satisfy the dynamic equititjrium condition retetivs to the desired 
motion p^emg. Ihs desired floor reaction force ts generatty described fc^ a torca and moment, and by its poit^ of 
action. Since lha point of a<3ioo can be set at s given point the desired Jkxjr reaction force has numetoos descriptions. 

IS However, if it is descrfced by takirig the afor^aid central point of the desired floor reaction toroe as the point of the 
acSon, the ntomant, at the point, of the r esuftant force of the ineniai force due to miim aixJ gravity is zem except for 
\t& vertical cimponent. 

As staled before, since tfie trajectory of the central point of the desired floor reaction force which satisfies the 
dynamic equitibrium condition relative to the desired motion patterns or trajectories is equal to the ZMP, the desired 
so IMP tmiestory can instead be used. Therefore, the aJsove can be rewritten as "the robot gait snot^ include not oniy 
the desired motion patterns or trajectories, but aiso the desired ZMP pattet n tx tfajedory (i.e , the pattern or trajectory 
of the oeotraf point ot the desired ffoor reaction force)". 

Tfws. the desired gait can be deJined, in a broad sense, as a set of the desired moSon trajectories and desired 
floor reaction *:»ce pattern tor a peiod correspoiding to a waftung step or st^. In a nanrower sense, the desired gate 
ss can be defined as a set of *te desired motion trajectories and the ZMP frajectory lor a period corre^XKtdlng to a singie 
waking step {ag., tje^mng item the siart of a doubie-leg supporting phase to the end of a single-leg supporfing 
phase). In tss sense, walking is con-prised of a series of gaits. Here, the dot^sie-leg suj^orttng phase ftieans a period 
during which the robot 1 supports its weight with two iegs 2, whereas the singfe-ieg stijpMtins phase means a pertod 
during v;*tich the rs^t si^jports its weght with one of the two 1^ 2. The leg which does not su^xirt 8i8 robot weight 
so during the singie-ieg supporting f*ase is cafied the free leg. 
The desired gait should satisfy the foiiowing condiSons. 

Condifion 1) The desired gait must satisfy th6dynansc«|uilifariwn condition, fn other worete, the ZMP trajectory cal- 
culated dynamically in r^ponse to m tiesfred motion trajectories of «ie robot 1 shouid be ec^al to the desired ZMP 
trajectory (i.e. , the tr^ectory of the centrai point of «w desif eri fioor reaction force), 
35 CondiSon 2) When a demand{s) such as a change in stride or in Ste ang^ of toming is made by a tocomotion plan- 
ner or path planner (neither shovm) of the rotjoi i or by an operator ftroitgh the y^tk* 62, the cksired gait stiOiAi sat- 
isfy such a dettmnd{s5. 

Ctwdilian 3) The deared gait shoiid satisfy conditions of constraint in JAtematics such as that the rd&ot foot must 
not dig or scrape the floor on which it walks, the joint angle must be within the movebfe range, and ft» joint aoguiar 
40 velocity nu(St not exceed «ie permissftjle range 

Cwtditian 4) The desired gait should also satisfy cor«litions ot constra'rtf in dynsBiiacs soch as the ZMP havino to 
remain vs«thin the foot soJe f taor-corttact area durir« the single^eg supporting phase, and tiiat «je joint totque must not 
exceed the poe^We maximum power of ihe joN actuators, 

Osodition 5) The desired gait should saMy ccMTKjigons of boundary. As 
« condition of bourxiary Stat the position and velocity of robot pwfions sudi as the body rmsst be continuous in «>e gait 
boundary, (if not, infinite fofce wouid occur or the ZMP would move far from the foot sole ttoor-contact area), 

IWiore specfficaily, the fina! state of n-th gait shoiid cerresponti to the initial state ot n-t-1* gait e^aecialfy in the 
body portion, orientation and velocity relative to the feet positiOf-i and orientation. 

As wis hs explained later, tiie desired gait is generated in this esTtJOdiment by a gait generation algorithm snciudinQ 
so parameters cr time-series tebuisted data. However, if the parameters ot time-series tabuiated data are determined with- 
out paying carefui attention, it is not certain whether the generated gait can safisfy aii cf conditions i) to 5) mentioned 
above, in particidar, «*ien generating the body tfajectories satisfying condition l) based orv the ailP trajectory, even 
VKh«t ranges of fte body postSon and v^ocity at «ie gait end are known. It is quite diff icutt to def ermirte the mp trajec- 
tory such that »te body posi^on mi vekxsty wifl bom be mffitin the range at the gait end. 
ss The reasons of the difficulty are as follows. 

Reason 1 ) The robot body tends to move J&rther frwn the ZH«P, aice inaiaiiy moved away f two ttte ZMP. This wiii 
be ei^lained using an inverted penduium mode!, shwo in Figure 4. The model approximates the behavior of »t8 robot 
body 24, 
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B the inverted persJiritim's supporting point 22a deviates item the r^pjection pcsnt of *e txnbai point of the cenlef 
of Ihe gravily of Jhe pwdiilum on the ftoor, the center of graviiy tends to move and moves tsrlher therefrom, "the 
deviafion thus tends to increase, arvd Ihe penduttim turns over. Even when the pendulum is turning over, the resuftant 
iorce of the iriertia! force and gravity of tfie inverted pendaium is actaig on 8ie supporting po'mi 22a (in other words, Sie 
ZMP is i<ept equaS to the suppor ttnQ point g2a). and the f esuttant force is k^t bali^ecl with the ftoor r eadion fores act- 
ing ttirough tte supporting point 22a, The dynamic equtiiitafium condition can onty describe an inatarrtaneous reia^orv 
ship between the inertiai force and gtavsty and the ftoor reaction force of a moving ofojeci. 

it is a frequent misconception that continuous robot waiMng em be ensured if the dynamic equiiibrium condition is 
ssfisfied. However, satisfaction ot She d>'r»amic equifibrium eondilion witt not ^tmite stabie robot wa!kif>g. Just as Sie 
center of gravity of the inverted pendoium tends to riwe ferther. if moved from ttre position imrr^ediateiy above the sup- 
porting point, the center of gravity of the fotoot tentte to rtiw«, if moved Ifom the postiott immedtafely above frie ZMP, 
move fer^f therefrom. 

Reason 2) The single-ifig stqjporftns {rfiase requires that »te ZMP mustbe wahinihe sj^ortstg ieg foot sj^e floor- 
contact area. Due to rigid condilions of coostrairtt sueh as this, it is di«icuit to detem^ne the desired body pattesm If 
the body patterns are deter mined mainty taWng b<5# position into account the v^ocfty would tetxi to be out of range 
at the gait end. and vice va-sa. 

Thus, it has hitfiertob&en dffficutt to generate or determiste tiie desired gait pafameters or tabuteted date, ona reai- 
time basts, vtfhich wii! satisfy alt of the possi^e gait conditions. The aforesaid prior art techniques described in the ref- 
erences couid not effect free robot wangling Therefore the appticani proposed the gait generation techf^ue m the ear- 
lier spf^ication (Hei 8 {1996) - 214.261). 

Whef? gertetatifig a new desited gait to be connected with another previously Q^oerated desired gate{hersirtaftef 
reterred to as "desiffid gaitn. the position (dispiacement) and veioctty of Vne body and feet n*ist be continuous at me 
boundary of Ifie iwo gaits. In the gaft gen^lion proposed eartier, s new desired gait (hereinafter referred to as "desifed 
gaif 2°} is eenerated in the iolitxMng (rshner, 

Firs«y, putting aside the cc»Kiittons concerrtng me body position and v^odty at tie boundary with tie desired gait 
1, m desired gait 2 is gensfated by mijong predetermined standard gaite prepared and stored beforehand such tfw! 
the desired gatt 2 satisfies the gait<Jemand{s). Then, the mi)t6d gait ts actted with additionat ZMP and ijody po^Son 
patterns (which satfsfy the dynamic eciufiibriom condttiorts) obtatned by ksshhq the ifwerjed pendufom modeJ shown in 
Figure 4. so as to generate the desired gait 2 which safisfies the conditions at the tjourtdafy with the desired gait i. in 
this ^ecjfication, the terms "mixing" means to generate a gait {which satisfies demands except for the conditians of 
iooundary) from a gait or gaits, and "mixed gaft" n»eans the gait thus generated. 

However, in the gait geneisfttcsi f»t^ed eariier by the af^icant, even when the demanded ir^ti^ body portion 
and ve»ocifydStfiatesrea«yfjrom those in tie mixed gait, the body j««erns are forca^ycwrected to satisfy the boundary 
condl^s. As a resutt, Ihere was a disadvantage that the magnitude of Ihe eorreded ZMP pattern sometimes became 
excessive, failing to satisfy the oon^drsint ccsiditions that, for exan^e, the ZMP most be within the foot soie ftoor-contac* 
^ea during the singte-teg supporting frfiase. If »ie magnitude of the corrected ZMP pattern was niade smaBef 80 as to 
avoid such a disadvantage , the body patterns satisfying the dynamo equiiajtium ooodttion ¥«r*J be degraded, resoftmg 
in snofher profc^em in that the f ina! body position and velocity woukt exceed the ranges t^^sw^Jhafe for ensuring cc«fin- 
uooB sfa«8 waSkSns. if this Situation is fefl unchanged, the body position would deviate largely, tendering*)© posture 
unstaWs artd causing difficulty for the robot while hoiking. Thus, fordbSy adjostit^ ferthe<»ncfit!ons of boundary of one 
gait to the other in the gait generation prtpased eai«er was insufficient. 

in wxSer to sdve the prc^em. the present invention etetenrsnes the ZMP pattern and the body patterns, taking a 
j^uraiify of gaits, more ^secrficaRy, «Ye gaits in two waling steps into account 

in fte gait generation proprsed eariier. as iSustrated In the m hand side of Figure 5, »rf\en two gaits are mixed to 
generate a new desired gait, since the brely position (and vetodty) in the mi«Bd ga8 are disowitinuous at the bourtdary 
of the walking st^. the IMP (dynamicaity cafoiatect from th€ JaaOf tttoticwt} shifts or mores to an inf iiiite point 

The inventor contempiated theprd:rfem and has ftsundttat, asSlysJraterf inthscsiier of FSgure 5, if the mate! body 
posjifon and velocity {i .e. , the position and its displacement veiodty of the cerfter of gtawfty of *ie pendulum) are intsn- 
tionaiiy made discontinuous in the direction opposite to those in She mixed gaiiatlhetKXjndary, the mode! ZiVfP shifts, 
in that instant, in the direcSon otposite to that in the mixed QSit by the same atnourt (•«} such that Jhe overall ZMP sliuft- 
ing can be canceled. More specificaiiy. it has been fatind that, if ZMP ebisined « «is dsnriamic deviation mode! is 
added to the ZMP safefySng the dynamic equilibrium condition relative to the motion of the mixed gait, as iusttated in 
ttie right Of Figure 5. the body posakxi (and veloeify) become continuous in the synthesized desired gait The ZMP s 
instantaneous st««(ng can thus be avoided in me s^hesized desired gatt, in cc»iclusion. unli^ the r^t mode! used 
in generating a gait differs greatiy from ttie dyrtamic deviation model, the safisfying the <^namtc equitibnum con- 
dition relative to the motion of -gie mixed gait and the dynamic deviation model ZMP acts to cancel one anottier. 

The present inv&nlion is made tjased on the above finding. 

TTie ZMP in the mixed gait is (Sifculated from predetemiined ZMP parameters during tdaot walWng. The ZMP eal- 
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culateij Irom 8ie predetermined 2MP parameters is inberefjay comit»«ous in ttie gait boundary. Acoordingiy, in deter- 
mining a desirerf ?MP Uosr. ihe ZMP in ihe mixed gait {cafcuiated from ihe predetermtoed 2MP parameters) arret the 
ii)ixi-;i 7MP <cf.i-,;ukiteci Irom the b3havio> oi the mode!), the influence of the mode! ort jhe ZMP caieed tsy making the 
modet positfoti stxi veSoci! y dts;Mnt:riL,otJB at the gatt boondsry, need tkA bft zero. In o&ier words, it is not necessary to 
esumaie how much ihe Z^JiP shifts in response to the tJiscontrsiify it syflic«s. as iHuslrated in Figis-e 6 if ihe body posi- 
tion and veiocit> in the modei ate va-.ed cjisconimuoiisty such that the discor^tinyity at the gait boundary in the mixed" 
gait IS Ganceted. 

"i ttB dyriamc devtation mode! shown Ftgurc 4 is si^aintsJ. 

The invertgc pencfutum model f^esents or describes )he tleviattoo or pertwbat on of the bocJy position and veloc- 
ity re!attv€ lo the deyistion of the 2MF. The model was used in the earlier af^icajiofr ar»d is a^ain used in the presait 
mmtion Assumirjg that the mass of the body 24 of the pc^c* i is sufiicientiy larger «ian those of Ihe other fntiot parts, 
arjd mi the body acceleration in the direction of gravity dotirnj waikjns is snafl. the devisSon of She body posftion and 
veioGfty rem^ to the 2MP deviation can be approximated by a linear ios^erted pendutom hawog a niovai:ri6 siworling 
point 22a, and is expressed as follows. 

dxmd/cfjsv 

dvtndij'ca = <i>0^ X (xnvjl - ZMPnid!). 

Hers, xmdi the posifion (in the X-direction) of the center of gravlt>' of the linear inverled pendulum; vmdi: the velocity of 
the center of gravity of the iaiear inverted pendulom; fisO: a positive constarrf value and is ddined wih respect to the 
height of flie center of grsvity b and 8ie gravitattoreif acceleratioo g as; 

Smce the rdsot is approximated by the linear irwerted psndulum. it becomes possane lo dewease the amount of 
caiculatton. In the abos^, Zli/tPrndt means the ZMP of the motJef. 

The system accofding to the present itivention uses the same dynamfe deviation modef as was used in the earitsr 
«)plicat!on. in the system, two frtxed g&tts are genef ated without paying attention to the oontinuity in the body positicwi 
and velocity and desired ZMP at the gait bounctery, and when a discontinutty in position or velocity occurs in the gener- 
ated rnixed gaits in the X-direcf ion or Y-direction, the model is manipulated $uch fwA the model body position ot velocity 
is skpaed by the amount Xs, Vs, or Sie model ZMP is continoousfy and gradually shifted by the amount Os so as to 
solve the discortfiouity in the body portion and vefocity at ihe gait boundary. 

At this pcsnt, terms used herajnafter will be defined. 

One of the two mixed gafts earlier in time is named "isf gaii". inrftfe other "2nd gait". The fina and second gate 
are conc^uai teriTK wihen discussing the behavior of Ihedyrtamic delation modef. Mweover. "ist mtx«t gait" and 
"2nd mixed gait" are sometimes used, wherein the ftwmer indicates a mixed gait to be used in generating the 1st gait, 
while the 2nd mixed gait indicates that used in generating Ihe second gait. 

The aforesaki discontanoify In the mtsed gait boundary is named The amount of dscontinuity". more speoficaity. the 
amount of position tfiscorSinuiiy Xm. the amount of velocity discwtfinuity Vm and the amowt of ZMP disconlinoify Dm. 
The ir^tenlional amount of sid^jping or ^tig lobeaf^led m catted "meamoum of skipping- as me ntiofied before, more 
^jedfically, Ihe amoura of model position siapping Xs. the amount ot mode! velocity stopping Vs, and the amount of 
modeiZft^PshifiingDs. 

The amount of model ZIWP shifting Ds is determined in re^nse K> m amount <^ ZMP discontinuity Dm. which, in 
turn is the error between the demand value of the iniCal free teg posttlOT of 2nd gaH and «ie NSal free leg posi«on 
of the mixecf gait. If the error is zero, the mixed gait is generated su(Si that its zm> is confinitou*. When the inifia! free 
leg position of the mixed gait is chsrtged in order to chat^e a wa»«tYg stride or pitch, however, the effor wit! r>ot be zero, 
rendering the mixed gait ZMP discorrtinuoys. The amount of mod^ Z(«P shifting Os is determined to cancel the errw, 

TTiese amounts ot sJ^ir^ and shifting are def ernwed as fofiowB. 

Xs--Xm 
Vs = - Vm 

Ds = - Dm 

As itiustf ated in Ftgum 7, the ZMP pattern to be appJied to *»e model is in a ir^zoldai shape. The heigtit c* trap- 
ezoid is named 't:»as". i.e, for the isi gait 'tst gaH ZMP bias Bl', and for «ie 2nd gait; gait ZMP bias ES". Titese 
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biases 81 , B2 indicate a steady deviatioo or perturbatiort of ZMP m the 1st and 2nd gaits In thedGsts^iptiort and figures, 
the position, ihe velocity and ZMP are referred to in the X-<Jifection {X-axis}, but the siime wiR aiso foe apptieci te 

the Y-directiort (V-axis). 

The origin of ihe coordinate system oi the model ZMP is set at the s^sporting ieg foot sdeffoor-contading surface. 
The ofigin Qi »ie comimm systenrt of ihe 1^ gaitis fterdore different from that of the Zn<S gml The modei ZMP w!i be 
conlitiuous if to view from «ie Isigait coordinate system, The isi gait ftnai modei ZMP is jet o when viewed from 
the 1st gait coordinate system, twtthe 2nd gait (nitia! mode! ZMP viev^ed irom i'm 2nd gasi coordiriate system is -Ds, 
When refsiacing the initial free feg poation of the 2nd m!)ssd gait with a demand value, the initiai poeifion of ZMP of ihe 
2rTd gait (wtiich is at the ioa) is shifted from lh€ toe by Dm, Accordi ngiy, by adding the model ZMP poaficn (viawed from 
the End gait coordtnate system) to the 2na mixed gait. th§ inrtia! ZMP of the 2nd vwt! ise posiSoned ^roprfetely at 
the toe (i.e., itro position shif^ from «ie toe by «ie atiwunt -Os - Dm {«0)). 

The calaiSation error in the mod^ wiii now be tacplamed. 

Whef} cafcuJation of the behavior of (he model relative to the mode! ZMP pattern i* congrtoad over a long period, 
as illuslrated in f (fiure 8, cafcitlaJSan errors, i.e. , ©tors in tfisf^cenent wif be accuditSated. Since the model nor mafiy 
an unst^e system. If erf ors are accumulated it wnll make the system osditiae. For exampte, if the model behavior caf- 
oilatiwt is continued over ter^ seconds, t^e modei cgicufation errors accumulated may exceed 1 degree, in order to 
achieve a tonq period oi continuous walking, the errors must rvof be accumulaled. For that purpose, a pluraJily of models 
are prepared in this system, and each modet is arranged to take a predetermined posture such as standing upright and 
stopping at a predetermined period or time such as the f inai waii<ihg penod such that the model dispiacement is equal 
to the mariipyated variable of the ZlWfP. 

More spedltcaily, tt^e present invenfion is presided vm (wo modefs as tthjsttated m RgiyeS, As iliusfratdd in Figure 
10, (he modets are applied with the model 2MP pattern such that each modat stancte uprig^ and stops wee every tt/o 
w^ng steps. After watkKtg tw st^ the mode! is for<abiy reset to zero, more precisely, the mod^ v^octty is set to be 
2^0 in such a marker (hat its disjriacement becomes eqiaf to the model mP. As showi in Figure 10. the fir^ mod^ 
vsfacity is mads zero at point A, whBe the second mode! veJodty is made zero at point 6. Thus. aWvaugh each individual 
mods! bshavity and its cafcutation is reset at every second mmg st^. synthesized model behavior is continuous as 
shown in the bottom of Figure 1 0, and the calculation errors wift on!y be accumutated wet the tjrtef periocS. "ffte model 
ZW pattern relative to the synthesized ftxJdel behavior can easily be generated by summing the mP pmm& of the 
raspeosve modeis. 

Based or the above, the operation of the system according to the present invention wiff be explained reference 
to Figure 3. irs the figure, Ihe operations illusttafed above the iine C are executed at the tjegfnrsng of walklns or once 
per waiting step, white those iust iated below.' the line C are exectsed once pes^ control cycle, e.g. wery 20 milliseconds, 
at whfch the jprognam is looped. 

in the system iiiustratsd. a set or group of standard gaits are provided sirttilsrtolhe system in the earlier appiioa- 
tion. The standard gaits have been gerwrated on a c£»npi«er (other than the first CPU 80 in flw ewitrol unit 26) in such 
a manner that they ensure a iong continuous period of walking up to the fina! step, wthwl causing (he robot body tra- 
jectory to diverge. The standard gaits which ensure a long continuous period of waiking are ty)»c^fy corrp'ised of a 
series of gaits havirjg a gail to start ws\kmg from s standing position, a gatf for accelerafing ihe walking speed, a gait 
for constant speed wal!«og, 3 gait for decsferating the walking speed, and e gait to stop wallafjg. 

The gait is described by gaii parameters The gait parameters ate comprised of motion parameters and ttie ZMP 
parameter {more geisrally floor reaction force psrametet}. The floor reaction ferce p«rame»«r is used in this specifica- 
tion to mean a paraneter retaJSng to ^ floor t eactton force pattern as a function of time. T1» ZMP trajectory has a zig- 
zag pattern, and the ZMP f»ramster is described in the dtrections of X, Y and 2 by the posHions of the braking pomts 
and anrivat fimes as shewm in Figure 13, As staf Mt before, (tie ZSjiP is rsfen-ed to onfy in the X-dire<aion, but ts strrjilar in 
the Y-direction- With regard to the 2-direction, sirwe it is assumed that the ZMP is conf irwous in that direction when gen- 
erafing the mixed gait, tt is not nece^sry to mai« If cor«Bit«)us by the model in that direction. 

The motion parameters are cotrp-ised of feet trajectory parameters and the body tfajectory paramsters. The feet 
trajectory parameters are conprised of initiai free feg (foot itfling) position and orientation, final ftee leg <foot iand&ig) 
position and orientation, and periods or iirro of the doutrfe-leg supporting phase mi Ihe singfe-ieg a^i^tstg piiase, 
etc. The fcKxty trajectory parameters include parameters defining the body Ofientatjon. the body height (a value in the Z- 
direction}, initial body position {dispiacement) atid veTocity, etc. 

Based on these, instantaneous values of the posfi<»i6 and orientations of bosh feet and the position, velociv and 
orientation of the body are generated in a ffSxed gait instantaneDos waloe generator in accoitfance mm the techrtique 
Foposed by (he awjilcam in Japanese Uid-Open patent sp^fcafions m 5 {1993} - 318,339 and Hsi 5 {1993} « 
324,1 1 S. in Ihe gart generation, the boundary conditions of (he body position and veiocity are negiected, in ttie ^jeafi- 
cation, the iristamaneoys value is used to descflbe a value in eardi control cycte. The vetocity fs delerrrsnsd by calcu- 
lating a diffatence between positional instantaneous vaiues in adjacent controi cycles. The oriemaiion refers to a 
direciiao in space. The body position is, as menlionsd eariiet. the position of the r^^entafee point such as the center 
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of mass of the body 24. 

A sequencer in the iiguf e controfe time in walking asid swife#wss the gaits. To be more specific, it tniliafess a timer, 
updates a timef tor every controi cycSe. vtstches the end of a desired t to switch to ancrther d8Sir«ct gaft, and initiafess 
a timet- so as to swSch the support.oe leg, etc. in the double-teg sup^orisog phase, in ord^ to iderttify the tegs, the leg 
k^t in contact with ttie ftoor during the SLtasequent Singie v^li^ing st^ is deemed as the syppcslirvg }eg and the ofher 
as the free ieg 

A gart generatiori msthcd (mcipe) dsieniKnato! deiemunes how to construct a mixed gait to generate a desired 
gait. More specificaiiy, it seiects the standasd gafts to be rtjixed, deterrrtnes wsishts for the weight^veraging catcoia- 
lion, artd an additionaJ amount lor the fr«e leg foot positicsi. Hsrs. the correctiof} amount is s ditference or etrof brtween 
an tnitiai free leg dermndad posftion in a desired gait and an imtiat free leg position in m rrtixed gait. 

A mode! behavior parameter deteririioafor determines or calcutates the atiKjynt of body position discontinuity and 
the amotjnt of model veiocify discwjSinu% Iwfeween the current (Tsxed gait and the next miusd gait g«iierat«J by the gait 
generation metfrod determinator. The model behavior parameter determinalordetemuoes^e amount of model positbn 
skipjafig. Ihe amoortt of model ve!o(3ty sloping, and the amount of mod^ ZMP ^ftirrg in re^jonse to the amounts of 
ijody posftion/veiooty disconfinoities and Ihe correction amoyrtJ of the tree leg foot p^siion. such that the desired g&tts 
f snaiiy stained ate conttnuous. 

The modei tiehavior parameter determinator also deterrriines the amount of IMP correction in response to the 
amount of mode! positiott skipping, the arrour^f of mode! veiociiy skipping and the amount of modd 2t^P sliifting and 
oo^)uts a trapezoidai pattern typically once per waSKirsg sSep, Since Ihe amount of ZNP cofrecSon is a IMF pattern to 
be fed to the modeis (illustrated as mode! R arrf irsodsi Ij , it is alEo referred to as "mod^ awlP", more spedf icatly ' modei 
im paramstef ' or "rt»de! 2MP trsjeciory farametsr". and is iiiustrated in Fioure 3 as "ZMP parameters for mode! R " 
and "ZMP parameters for model L". Tim model mP parameter is deccribed by the heis^tt of the trapezoid. *fa amount 
of mode! ZMP shiftin§ and the Sme t*le at each bratdng point. The fime tatte may, howamr. be fixed for aff the gaits, 

A model ZMP trajectory gweratw caicufates the instanjaneous value of the mod^ ZMP based on the atore^kJ 
mode! IMP parameter: As stated abov e, the system is ptov<d«i with two dynamic deviaton models {illustrated as R. L) 
and in response fiiereto, two iTicdei mp irajtsiarysenemtors are prowded for the model R, LThemodeteR, tare the 
inverted pendulum dyr>amic devotion mcdeis which cafculate «• detern^ne the quaoKties of state &\i<Ai as rtwdei body 
position, and model body velocity on a real time basis. 

A gait mixsf generates a m-.xm gaii, awe s|>eclffcaf!y, mixed gait parameters of the siandard in re^nse to 
the gait generation method determined by the gait gsna-ation method determinator in accotdance with a mixed §^t 
generaJion algorithm explained later. 

A mixed gait instanteoeoos value generator d^ermines or caicuiates instantaneoos values (i.e., values in each 
wntrol cycle) of the mixed gait, more speof ioaBy. mixed bocJy position and veJociiy, mxed de^rad ZMP, mixed body ori- 
entation (desired body orientation} and mixed feet position and orientation {desired feet position and ortertajlon) in 
response to *e aforeeaid ©ensfation method in accordawe with Ihe gait generation atgorNhm 

The determined n^xed body position is added to the sum of the displacements of the mode! R, L (determined by 
the models R. L) to determine the desired body position. Similarly, the determined mixed desired ZMP is added to the 
sum of ZMPs {defermhed by the mode! ZMP trajectory generators for the models R, I) to deferrriine *e desired ZMP. 

The desired body position {and velocity) and the desired ZMP as wei! as the desired body orientation and the 
desired feet posiiSon and orientatiCMi, are sent to a stability oonirolier tn which sonw of the gait instantaneous values are 
corrected or nwdif led by controSed varlaWes (detected variat^es) such as body inclfnation (tippit^) angJe. and thereby 
e corrected desfred body posfijon and orientatim, corrected desired mP. corrected desired feet position and orietta- 
im. and corrscfed desired body orientation are determined. The opwaibri of the st^ity contr«^!er corre^wndsto the 
aforesaid eon^iance control 

Output of the stability controller is sent to an inverse IdnemattG calculator in which joint angle comrrends are detar- 
ministic^ly calcinated by an inverse fonenaSc soiuticn. Since the robot 1 has 12 joints, tie commands are cafcutatsd 
fwJhe IS joints. 

The ^ove is the t^erstioft of the firsf CPU 80, and based on the cormrand vaiues, the second CPU 82 condwdB 
ihe joint servo controt such that joint angles traces the commands. 

In *)e above, the stability controller and the inverse Wnematic calculator are not included in the system according 
to the presertt invention and since tiie (^erafion of the canirolter and calcui^ are described in earlier appficattons pro- 
posed by the applicant, no further esqiitaflation m\\ be made, 

Hereafter, the standard g^ are further eiqjiained. 

The standard gaits are ctescrtoed in »)is specification as time f tstcttons. Each standard gait is d^aibed by a set of 
8(t) and f(9 defined as follows, 

g{t): gait fijncfions d®cribio§ the motion of «ie roi5ot, ^ecificaffy, ihe lunctiorts represent the posiSons and orien- 
tations of the robot conponents at titTie t mor« spedficalfy, *te positions and orierftafions of the robot body and 



teei; 

f(;t): gait {undions describing 2MP IrajecEofy. Specificafly, Ihe (unclions fepresenJ. as meniioneti eariier. the posi- 
tions {x; >'. 2) of ihe at time t. 

To be more ^ecif ic, 9(1} and f(t} are functiom which am ttefined by ihe gait pammeters. >ythoii^ it is pfeisraMe 
thai al! the paramtsters are represented, so as to <Se»-(y incficafe a gait ance *>e ntmber of parameters is iafge, onJy 
those paraineiers necessary for Sie Allowing ss^iar>ation are cf^rlfeed here, 

g{t a, b, c, a, x{t^, y<k)): funcSioos describsng robot motion trajectories; 

Hi: a, b, c, d): functions deeeribiRg the 2MP frajectory {junctions descrasins the fioor reactiof! force). 

where: 

a; tnftia! Irse ieg foot orisnMon ^ifKSicattve of 4he lurning aojte of the robot) 
b; iriitia! free ieg fCK>t posftions in tie X-direction (walking s&kie) 
c . t)e K-coofdinate of 2MP in the sinate-ieg supporting phase 
d: the Y-coordinale ot IMP in the stngte-ieg suc^'or^ing phase 

the X-oooPdinate of body positior^s in time-series 
y(k); ti>e Y-coottiinale of body positions in time-series 

in the representation, ti>e lims-series data is treated as a tend of parameter. !*erenjjy, withojt a Sme-series tabie 
deso-ifcRftg ths body position, the gait is solely or detamnisticalfy detetntined based on the parameters of the initia! 
body posftion and velocity and a constraint condition defining the body h^gta. The body position time-series tiata is 
ihiis redundant However, in oider to shorten the gait generation time in a reat-tinte basis, the body posHion time'^sertas 
data laWe is treated tiere as a kind of parameta- descriKng gails, 

in tie embodiment, the initiaf body position and vetocity parameters are dilferent tor different gaits. Since, however, 
the initiat body position and vetocity can be caicuiated from the tirsi and second vaioes ot the body posrtion timfe-sef ies, 
no further ej<f)!anasoo 1$ made here. 

in the ©mbocSment. the standard gaits such as that for Oeginntf^ walking item stanoirjg position are prepared on 
an off-iine conpotet as mentioned jweviously. Ttie tottcwtftng three gaits are examptes. 

standard gait No. 0 

g{t: aO, bO, dO, xO(k), yQ{H)) 
J(f: aO, bO, cO, dO) 

standard gait No. 1 

g{t si,bc. cl,dl,xl(k), y1{H)} 
f(t: ai.bO. cl.dl) 

standard gait No. 2 

g{t:a0,b2,c2.d2.x2{k),ya{k)} 
t{t: aO, bs, c2, dg) 

Figures t1 to 17 illustrate the mdiaf trge teg foot posificsis and orientals, andthefirra! tree leg foot posmons and 
orientations, etc. in otder to dsscritse the gaits the cowdinate system is set wth a reference point on me supporting leg 
foot sofefioer-conlact sorfeee as the origir^, and the to arjcJ-fro direcfco of the supporiirsg ieg foot the X-direction «nd 
iim ieft-to-fight direction as the Y-dir ection. 

Assume that the demands tor gait are gtven as stowri in Figures 18 and 19. Tai<frigassn exanpiethe gaitgensf- 
attcm ta sattsij^ng the demafid using iite stendard gaits, the operation of Uie process of gait mixing is expiained. 

Ttia demanded mixed gait should have a given intttai free teg ort^tation a3 and its to-and-fro position b3 ft shoufd 
be noted here that m body position and ^flstodly at the g»t boundary and the initial aid f inaf free ieg fbet positions are 
not aiways tndicaf ed in the gait ttemand, since «ieae can be satisfied if the mode! betavior is added to the mixed gait. 

in the mixed ^it generation, the parameter a is as and is b3 in the demanded mixed gait. The probfent is how to 
det^-mine tfie osier parametets c, d and the table vatues x{t<). y(i<) so to satisfy tie demand. 

The demanded mixed gait is first described as fofiows; 
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S(t:a3. !33,cS,d3.x3(f<).y3{k)) 
f0;a3.t)3, c3,<j3) 

Thert {he other parameiers aw deterrmned, 

Hefft, the terms are defined. 

The parsmetera a. b inciude values input «(S a fequesJ (same as the atoresaid cie«Ta!x3 fot gait) irotri outeicJe of the 
sysism (such as by an operasof via the joystick 62} or through anottsa' systent. 7>ie parameier v/hose vslue is 
dematiclect direcfiy lo be a determined value caiied 'direcSiy-determined parameter" On the other hartd, parameters 
such as c, d. Of the tabies x{k), y(k) are dspsrtdeni pararnetere or iabufated data, since they are cteter mined based on 
the directiy-deter mined parameter such that they satsfy Ats gah condWors. Since ii is quite diiticult to directfy deter - 
mine the time-series tatjuiated data, the ttme-series tabuJatfid data is rarefy a dit ec^y-deJetmrneci parameler. 

The aforesaid standard galls No. 1 or No. ? {oiher than the standard gait Na 0) are based on the standard §&H No 
0 arjd cmry one ai the directfy-dsJsfmtftsri pa(am«t«fs, {i.e, a or fedifters from that oi standard gsH No. OJ. The basic gait 
amortg the seiected slandatd gaits, i.e., standard gat! No. 0 is caiied nm Isase gait. 

The deferrnioatton of the demanded gait parameters (referred to somatimes a$ "trsj^d parameters') wa( be 
expfained. 

The d^ndeni parameters g5, dS and tine dependent lafeoialed data x3{k). y3{k) wary in rei^sonse to the diractiy- 
deter rryned parameters a, b so as to satisfy the conditiorw of gait. Moreover, it ie si^^josed that they vary coRtiouousiy 
(FT resporjse Jo the change in the parametes's a, tx The \?a!ii8S c3. d3, etc., are «iereft>re continuous tunciJone of 
parameters a, b. s his means that the foitowwg prirK^e of ^rtwimatiCHt cart be uttfiied. In other vwsfds, the demsftded 
gait parameter can be calculated by af^oxsnalion. 

To be more sjjecrfic, « function p is a contittuous function, it can be apjs-osamated using the foliowing expression. 

P{aO+Aa, bO+Ab) « P(aO, bO) + m 8aJ {a « aO, b » bO) x Aa + mm {a = aO. b bOJ ;< ab Eq. 1 

here, 

sP / m.\ ia. = ao, b » bo^s a partia! differemial ot P relative to s at a « aO, b » bO; 
6!* / iibl (a « ao. b « bO) is a partial differenlial of P r stetive to at a = aO, b = bO. 
Moreover, sines 

8P f Sal (a aO. b = bO) »^ {P{aO + Ael, bO) - P (aO. bC})/AaT 

gp / SM>\ {& « aO. b « bO) « (P{80, t>0 +Abg) - P (ao, bO))/Ab2 

Eq. 1 can be rewritten as Eq. 2. 

P(aO + Aa, bO + Ab) = P{aO, bO) + \P{aO Aal . bO) - P(aO, taO)]/Aa1 x Aa 
+ iP{aO, bO + .Ab2) - P(aO, bO}}/Abg « Ab 

Continuing the explanation, tfie demanded mixed gait parameters are caicutated from ibe standard gaits by dividing 
ifrtefnaiiy or exterrrafty {i.e.. interpolating) aif the dependent parameters and time-series iabulated data using the totow- 
tng equations. This is because the d^endent parametSJB and tabufated data in ptxsportion to the tiiracliy-detetmir^ed 
parameter, if a3 is between a1 and a2, it is calcoiatsd by intemat division, and rf aS is not between al ar^i a2. it is 
obtairfed by externa! division. When the differance in the parameter can be nesiected from the point of dynwnics, Sie 
parameter may be the same as that in Jhe base gait, ff 8ie fima-saries talsjiated data Ss caiciHated in the first CPU 80 
at one time, ttie ioad of caicuiation tjecomes great. Thus, it suRtces « the intemai or external division is oondocted only 
for data in the current control cycte. 

The foliowir^ are *ie aioresafei equations fw mixing using internal or externa! division, 

03 = CO + (C1 - CO) -K (as - aO}/(ai -aO) + (s2 cO) x {m ~ bO^bS ■ bO) Eq, S 

d3 = do + (di - dO) X {33 - aO)/(al -aO) + (d2 • dO) x (b3 - b0)/(b2 - bO) 
X3{h) « x<m + (xm • y^om (as - aOMai - aO) + {s<2{k) - >tO<l^) ^ {tss - taO}/ {b2 - bO) 
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je{k) ^ yO(k) + {y1(k) - yO{k)} ^ (a3 - aOMal - aO) + {y&(k) - yO(k)) s {b3 • bO)/ {b2 - bO) 

These equations are wetglited avejiage caicufaijons erf ibe standard parameters and tabulated date. Ttie f itst equa- 
tion can be re»s'fiaen as Joilows. 

c3 » {1 - (aS - aO)/ (al - aO) - {m - bO)/{b2 - bO)} cO -e- ^a3 - aO)/(ai sO) s cl + (bS - b0)/(b2 - bO} :< c2. 

Stoce the sum the stfeighted coeif icieots of cO, cl , c2 is i , c3 is a weighted average whose weights 0} cO, ct and 
2 are reBpecth/eiy; 

{1 - (as - aoy (al - aO) - (bS - W)m - &0J} 
{aS-aO}/{al-aO) 
tb3-bOKbS-bO). 

In the manner ej^iained above, the naxed gatt parameters are determined, and instanlaneous values jhereo! (i.e, , 
the va!ues al each controf cyoie) are generated in the same way as the gait generation aigcwlthm of the standard §ait 

Based on tf>e above, the operaJion oS the system accofding to the inverttfon wiif be expteined with reterence to a 
flew cftart shcwr^ in Figure 20, 

The (xogram begins al SIO irt wNdi me standard gaits prepared by an eirternsl con^uter are toaded to the ROM 
84 (or RAM 74} Of the on-iaoand microcomputer (flie first CPU 80 of the controi unit 25}. The program proceeds to Si 2 
in which final body position and velocity in each starxJard gat! are calculated and stored in the nrtemoty. 

When gerterating a rrexed jjatt by caicuiating a wetted average of a piuraiity of standard satts while keeping the 
supporting !©g positions and orientatiorjB unchanged, the iniSaf and fine! body positions and vetocities are equai to the 
weighted averages of tne imtia! and tina) body posifion and vefocity of the standard gaits, for this reason, »ie initiai and 
tinal bffi:iy i:ioBii>onB and v^cities tn the standard gaits are slwed as fatooiated data betor^and and^ are read during 
walktf^ to determine or caicuiate the initiai and final liody positions and veiocities ot the mixed gait. For example, since 
the txwy positions have been prepared as a function x(k) as mentioned above, the final body position and vefocity are 
calculstBJ i!C)m .fie fina! value arid ttie value preceding the tinai vitiue in the tatsulated data. More specifically, the final 
value in the tabulated data is immediaiefy determined as tiie final body position, and the diSe-ence between »iis value 
and the value preceding *e final value is caicutated and is used to delermine 9w final body v^octty. 

Tile program Sien proceeds to Si* in which toiowtedge or infomaSort relating to the aiwesaid dynamic deviatiw 
model is obtained. 

in order to predict the mode! behavior quicl<iy to iomwdiafeiy determine or cateutete the modei mP pattern whit^ 
can effect the model behavia as desired, the characteristjcs of modei behavior relative to ffte i«)icai moctef tiftjectory 
fsitlern are calculated or determined beforehand in »tis embodimeot and ar« stored in the ROM 84 {or RAM 74). The 
typical inodef ZfytP pattern is referred to hereinafter as "basic modei mP patter-n". More specificaSy, as illustrated iil 
Figures SI and 22. tt?e mode! displacement, i.e.. the characteristics of behavior relative to the 7MP bias, when the 
model ZMP is displaced in the ^st and 2nd gaits, is caiculated or determined beforehand snd is stored. Moreover, as 
iiiualrated in Figures 23 to &S. the amount of model ZMP ^ng, the snKsur* of mod^ position si<3pptng and veiociiy 
akippsng, and the characteristics of «>ode! behavior per unit amount are calculated or determined b^^ehand and 
stored. These w8l be used in the detamiirsation of the 2MP bias ejipiained later, 

Ttie model MP trafector y pattern Otiusirated as "model ZMP" in the figures) is determined in the shape o* a trap- 
ezoid as mentioned earlier, and the time distrttution ot time table is defined by the ratws of 1 st and 2(Kf gaSs {suc^ 
as gait to start waifeg. gati for normal turning, gait to sic^ waging), in the l^ac mod^ IMP Iratectory pattern param- 
eter, only one of the paranisters other man tjme distribution is detemiined to be a iin» amount, wNie the o»mm« are 
determined as zero Spedficaify, supposing standing uprigtn and st<WKng (i.e., the mode! displacement becomes zero) 
as the initial state of fte modei, the model behavior in response to each tjasic ZMP trajectory pattern is determinsd 
through repetitive calcuiajjon or analysis, and the final modei position and vefocity of the 2nd gsit are stored. 

While, similariy su?:^ing the upright standing and stepping as the modei initiai state and si^^sing the model 
7MP as being zero, the behavior «*ien the mode! position m v^ocity is tiiscorjlinuou^y Pepped by the unit atnount at 
the boundary between the 1st gait and Snd gait is calculated and thelinai mod^ portion and vafodty of the 2nd gait 
are simifariy stored. 

Sine® »ie modei is linear, it becomes possible to obtain a mode! b^vior having any desired character by finear 
eonftiination of the basic mode! behaviors. Thus, it becomes possible to awjropriaieiy caicuiate a model ir^ut frt»n the 
linear combinatton of the basic irtodel ZMP patterns, hence decreasing the vcfame of cateulation. 

Resurniffg to She Kspianation of Figure 20, the program proceeds to S16 in which the mode! arid the parameters 
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retati«s ihet eto incSuding modei traiecJory parametere soch as ihe attioum of sk^^ng stihe gaft boutidary, mtxM 2WP 
parameters, etc., ate initiaiiirsd or reset. 

The prograrF! p'oceecis to S 1 S In which the timer vaiue 1 is reset to zero (in other words, the timef is startetS^, to 822, 
via S20, in v^.'ich a time: interrupt is waited ior (xbi timer is different from that in S1S). The lime intemipf is 8)teou!eet 
5 once per pf edetertnined perioc {i.e.. the contro; cycte) such as 20 ms. 

When th« timer irstetf upt is effected in S22, the prograsr pjooeeds io S24 m which it is determined \**jet!ier the gait 
is a; the lime of switching, snore spech'tcaliy whtthw the ctjireni walking step has been oofTj^eted, Whert (he result is 
negative: flie pragrarrs immediatdy jynps to S32. On the othet hand, when the resuJt isaSitTOative, the foS"^*" P'O- 
ceeds to S26 in which the timer is reset to zero, to S28 in which «»e sijpporfinjj is switched to the other side, more 
1$ preciseiy the current so^jorting teg becomes L {toft} the preceding was R {rigft), or R it fiie preceding was t. For ease 
of explanation, it is assumed that the current sufpjrlirig leg is R end the current free teg is L 

Morsovw, ftMT ease of onderstandftis, the terms "cunreht gar, "fast gait" and "osct gaft" are eupJained. The cun-snt 
gatt ie a gait which is generated and ou^ut at the cmeri control cycie. The gait Just before the current gait is the last 
gait. The gait that fciiows the current gate is the nect gaft. Again brief if es^ained. the tst gaS and 2ncJ gait are concep- 
ts tuat gaits used when dscossing »ie mode! behavior. 

The prosram proceeds to m which gait switching procedures are condiicted. 

Figure 26 is a st^roi.<tine f few chart shewing the gaif switching procedures. 

The program starts in StOO in which, since it is the time of gait switching, the gait parameters are i^ated. Specif- 
icaity, the vsiues of the cuirent gait (in memory) ate moved to fhe previous (las}} gait parameter (io memory) , and next 

SQ gatt pararneters are moved to the current gait parameters (in memofy). The identificstion number of standard gafe and 
their wets^ts to be mixed to generate the n&a mixed gait are rewritten as those tor the ctitrent mixed gait. 

The progmm prcweeds to Sl02 in which it ts ttetermirted whether 8te gait is tor initiating walkir^, t,©., vrfiether it is 
the start of walking from standing pfflsifon. W>8n the result is nsgatwe, the fKogram jun^ in Si OS. When the result is 
afffftnattve, on the other hand. »ie program jxoceads to S104 in wWob the (tettaoei wafue of (he d!reotfy<tetermi{ied 

2s parameters of the current gait {i.e. . l st gait for the mode! fi) are read. The program proceeds to St 06 irt wf^ch standard 
gaits io be mixed are selected and weights are determined in order to gensr^e the cuirwtt mixed gait tst rmsd 
gait tor the modal R). At this time, it is possible to neglect the demand for the final free !sg position. Howewer. the rtAwjt 
turning angle (I, e., the initiai free leg loot orientation) ^wutd be satisfied if dwnanded. 

The program proceeds to S 1 0S in wh(<*i the dettjand value lor the dsrectty-determined parametars of the next gait 

30 {2nd gait) is read, to St 10 in which standard gats to be nSxed are sheeted and weighs are determined in wder to gen- 
erate the ne« mixed gait (2{>d mixed gati). At this time, it is possibfe to ne^ect the demand Jw fte tniltai arid f inaf free 
ieg positton. However, the robot turning angle {i.e., the inifial free leg foot orienSaSon) i^ouW be satisfied il demanded. 
If standard gaits whose initial free leg pissattons are d^ertt trom each other hs^e bean prepared, the nearest or closest 
one to the demand is sheeted as the base gait. Tlw mixed gait need netforat^y be accorded with »te d«nand value, 

ss since, if forcibfy accorded, the txxiy traiectorias would deviate greatly from the standard gati, degrading iong period 
walking continurty. 

The program pr oceeds to Si 12 is) whicii the tnodei tmieclor y parameters and the ZMP parameter of the model R 
are detarmined. The model R's trajectory parametere should be determined such that the nxxSei R cancels the discon- 
tirtuity at the fwufKlary between the current mixed gait (tst mixecf gait) and the ne>i1 n^xed gait (2nd mixed gait). The 
40 model R's ZMP parameters should be determined soch the IMP trsjectory of the current gait is continuously con- 
nected writt that in the next gait and the model R st<^s and stands straight aft©- two wal«ng steps. ir> other words alter 
the next gait t>as been consisted. 

Figure 2? Is a Ibw chart shewing Htm si^rcMJllrte of the parameter dsitarminalifin. 

The program begins at S200 in wNch «ie amount (differ^we) Dm between the irwtjal free teg pos'itton demand 

45 value for the Srtd gait and fhe initial free teg postton of the 2nd mi)ced gait {rrwiied gaif for the 2nd gait) is calculated. For 
ex&'npit;, when the initial fee leg position of the 2nd gatt is predicted as -50 cm, but that Cff fhe generated mixed gaS is 
-40 cm, the procedure in this step is fo calculate the difference (= • 10 cm). 

The program f»-oceeds to S202 in which the value -Dm is substituted for tse anrount of model ZMP shifting Ds In 
the ZtvlP parameter of the modef R. Agairi taking the same exanpie, this means that She amount of modef 2MP shifting 

so is rewhttsn as ^Ocm. 

The program proceeds Jo S204 in which the final body poafttai ai*3 velocity of the cyrrent mixed gait (isf mixed 
gait) and the Initjal body posifioo and velocity of the next mixed gait (2fld tnixed gait) are determined. This is done by 
moltipiyfog final at>d initiat body positions and velocities of flie gaits by mbeing w«ghtsand by summing the products 
tnweof. Since the final body poafcn and v^octty of the standard gaits have been oWained and stored in St2, the cal- 
ss culafiOR can be sped up by using ftie stored values. 

The program proceeds to S208 in whim the amount of disconiifuiity of each of tie body position and veiocity Xm, 
Vm at tte tx>undary of the current and next mixed gaits are caicuteted- 

The fxogram proceeds to Ba08 in wtiich, in order to cancel tfie amounts of disjonfinuiSes Xm, Vm. the amounts of 
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mcde! posifion sWpping Xs and velocity sKippmg Vs of the nwdei R trajeclory parameter are substituted tor the recipro- 

cai number of the amounts o? diaceminutSes. i,e , -Km, -Vm. 

"Hie program proceeds to S210 in whtc*i the atnoimj ct forciWy shiJfing of the l5t gait and SitS gait 2MPs {s.e , the 

atoresaW basses of the 1st gast and Snd gait) B1. B2 of the mode! R ZMP parametej- are determined swch »st the model 
s fi stops at the end of the 3r«J gait, in other wojds the final mode; posftlon Xc becomes Ds {i.e., -Dm) and tfie timi model 

velocity Vc becomes 0 when viewed tfomthe is; gait coordinate syslsrji, 

Specificaiiy. the ZMP biases B1 , B2 are determined in acx5wdance with ihe toliowirig prificiple. The IMP biases B1 , 

B2 Of the 1si and 2nd gaits are best iliystrated in Figure 7. Ex^ining the principie, ii the mode! is maaiputated to 

behave as ds^armtned afrioiints of position stopping Xs, veiocit/ eWpprng Vs and BJiP shiffing Db, and with «ie Isiasss 
so 61 , 32 made sero. since the rtiodef b^tavior is 8 Boear comNna^on, it »sH ba *e sum of each behayiof resulting in by 

each detarmined amount. THs means that the final modef portion Xc and uetocity vc in the 2nd gad can be c*>tatned 

from 4. in the equaltort. the constsrJts usscf «re shown in Figures 21 to 25. 

Xc « Xx X {-Km) + Xv K {-Vm} + Xd x ^-Om) Eq. 4 

Vc = Vx X (-Xm} + Vv X { A>m) Vd X {-Dm) 

The isl gait 2MP bias B1 and the 2fid gait ZUP bias B2 shoutd accofdingfy be determihed sudi 9iai. when the 
behavior m resporise to the l st gait ZMP bias Bi and the 2nd gait 23«P bias B2 are added with ttie ^xwe b^iavior, Ihe 
so robot position Xc becomes Ds fi.e. , ■ Dirs) and the veJodty Vc iaecomes zero at Uie end ihe 2nd gait, 
For that purpose, Eq, 5 must he satisfied, 

Xx x {-Xm) + Xv>«(-Vfn) + Xci x^Om}4-)03l x B1 + Xb£ B2 « -Dm 

ss Vxx{-Xm) + Vvx(-Vffl) + Vdx{.Dm} + \«>1 x81 + Vb2x82 = 0 

Eqs.4and5yfetdfiEq.S. 

Xfct B1 4 Xb2 X 32 = -Xc -Dm Eq- 6 

Vbl X Bt + Vb2 K B2 = - Vc 



AccofdioQiy. the modd posfticin Xc arei veiodty Vc tan be cafci^a^ ffOt« Eq. 4 and t>« ls( gait 2MP J»as B1 and 
the 2nd gat bias B£ can then be cateufated by solving «ie simuiteneous equatiorjs shown in Eq. 6 
sj; i^eturnirtg to the exptanafion oi Figiire 2S, fr>e program proceeds to S114 in v»*ii<*i ihe position and vetectty d the 
modei L {which was started one waging ear lier) is <45efat6sj {sS^if^ed ) in response to the amounts of position si«p- 
ping Xs atid velocity slopping Vs of the mode! L caiciiated in S210 one walking step eariier. Moreover, the coordinate 
system for the model L arsd its ZMP parameter is switched to those the current gait coordinate and the model L and 
its ZMP parameters are translated in response thereto. Since the modeS L began to move one waiking step earitar, for 
4<- the modei L the tst gait is the tast gait and the secorKf gait is the ciirfent gaif 

The program proceeds to Sl1 6 in whicti me mode! R is tor ci«y aosped and made to take a tpoght standing pos- 
ture, in other vnords, its position and veiocity sre made zero, to pra«nt calcolatlon errom from being sccutnoteted. 

The pfogfam proceeds to S118 in which the current mixed gait param«{ef5 are generated cm the ba^ of the 
seSected standard gaits and the detarminecJ weights. They are those t*ilained s® the n«xt mixed gait patameftara in 
4S S1 10 and moved to the cyrr^l mi>©dgait parameters in SlOO, unfass the current gait ts that for inifiatSon of waiking, 

The la-ogtam proceeds to S120 in which the final free ieg position of the current mixed gai! is sutjstiiuted lor the 
demand vaius. Since the change in final free teg position by the demand vaiue, if it occurs, resuits in a siight ciiange in 
the inertiai force of the free ieg, this affects the mixed gait dynamics iitfie. Th&'efore, »ts ZMP parameter need not be 
changed even when the f ioai free leg position is cfianged, 
sc The ptogram proceeds to S122 in whic,^ the initial free ieg portion of Siecufrsnt tnixed gait is rewritten or varied 
such that S-ie sondttwjns of boonctery ot the current mixed gait and the oert mixed gait accord with mch <aher. Precisely 
^6af<ing, since ^e free !eg is stiii on the floor in the doii^e^ss «i?ipofting f^$e, tie free teg is leg which visl sub- 
sequen«y be Bfted. fflheinilia} ZMP ^ftstromtiiefree leg toe (»4«retheZI«P should iniifafly be) by changing the initiai 
free ieg posiSoa it can be remedied ot corrected by the amours of njodel 2MP shifting. 

Returning lo the eypianatton ot Figure 20, the program pfoceeete to S32 !n which irtstarrtaneoos ^iues of the mixed 
gait are generated or determined. This wii! be the same «*en the result In S24 was negative. 

Figure 28 is a ftow chart shovsring the subroutine lor flie insfartaneous value determination. 

The program begins in $300 in which a mixed desired ZMP at time t (t. the time of current control cycle) is caicu- 



14 



EP0 856457A2 



iaied or determined isased m the trexed gsts parameters. 

The program proceeds to S302 tn which nrnxed feet position and Ofientaljon af time t are cafcuSated w determinecJ 
based an the mixed gatt parameters u^ng th@ aforesaid tecHraque proposed aariier. 

The program proceeds to S304 in which Ihe body height at Sme t is cateulsled or determineia based on me mixed 
(set position and orienrtation at time t and the horizontaJ body positton ai time i • At, using, tar example, the technique 
mwitioned in Japanese Patent Applic86on Hei S {1996) - 214, 260 proposed by the aj^siicant. 

The program procseds to S306 in which Ihe hortasTJa! body postgoR at Sme t is cafeuJated or deternro^ed based on 
the body positions at i^ i in *6 saieoted EtanrfaixJ gaits {including the base gait} osng 3, Thus> all the ir^stantane- 
ous values of ^e n^xed gait ar« determined. 

Retummg to the escpisnaSon el Figore 20, the progfam proceeds to S34 in which ths currer^t iostartaneoos values 
fw ttie models B and L are catcuiated. 

ExpSaining this, thft instsntaneous vaities oi the rriodei ZMP of flie 1st gait are catcuiated ortfstefmtned based on 
the model R ZMP parameter and the vaiues thus obtained are treated as the instarstaneous values of tie modef R. Neict, 
based on the modei L iMP parameter, the instantaneous vafoes of the mode! 2MP of the 2nd gait are calculated or 
determined and are treated as the insiartaneotis vaiim of the mods! I. As mentioned above, the cwrdinate system of 
the 2nd saft different from *at the 1st gait. The coordinate system for the 2nd gait is detwrrwtsd such that ihe 
vaioe of the Snd gart modef 2MP at the end of the dout^e-auHsofting phase is zero, as ffloslratad in Rgure 28, 

The program proceeds to S36 in «je fmdeis R. I are apj^ted or substituted tor the instantanegus values of 
the modef ZMPs thus obtained, in addition, fiie model ZMPs of the tKtto modsls are acbted together to obtattr Ste sum of 
the modef ZMPs Simtlar iy, the displacements pocfy position dispJacemenfs) of the models R, L are add«( together to 
determfnethe sum of mode! dispiacements, as shown in Figure 3. 

The pro-am proceeds to S26 in which the mixed ^ait is synthesized with the modeis R, L. More spectficaliy, as 
iilostfated in Figure 3, Ihe sum of mode! dispiacements just obtained is added to the body position and vetocity in the 
mixed gait to deiermina dotted body position and veiod^. The sum of mode^ ZiMPs is simiiarty added to & desired ZW 
in the mixed gait to determine a desired ZMP 

M stated beiofe. no att&tfton is paid m this en^rnnent to the change (if made} of the initia) free leg position in the 
ZMP parameter of the mixed gait. Snce, however, ifte change of ZMP trajectory necessary tor a possibSe inifiaf free teg 
posttionai change fs mim account in the zm> trajectory of the model, the eventual ZUP ir ajectory of the desired gait 
wit! m free from discontinuity. 

The program proceeds to ©40 in which the lime is t^xJated tf/ At and then ( eturns to S2Z to r^>nst ttie procedures. 

Ttrus, the desired body position, desired body orientation ^xjdy ot ientation it) the mixed gait), desired feet posiSon 
and orientation (feet position and orientation in the mixed gait) and the desired ZMP are d^ermined. Titd staWiity coft- 
tfdier changes, if needed, the instarrtaneoos postvire determirsed by the above parameters, end fsased on the instanta- 
fteous posture, the inverse kinematic cafcoiator caicutates the joitrt angle commands, 

i^avif^ been configured in the foregoing manR«r, the system in Ate embodiment maites tt possiiirie to generate a 
gait freefy on a reai-time isasis such that the robot wattts for a long continuous period Of time, for ^trple, with a desired 
stride or turns in a desired angle. The system afso mat<es ft pos^We to drive the biped robot, on the basis of the gait 
thus generated, to watk as desired. 

in the operation of the system, starvjard gaits inctiding the base gait are selected ffon> among those prepared 
beforehard in response to the demand for a gait with particular corxfitions such as a certain stride length or turr^ng 
angle. The ssiscted gaits are subject to mixing such as synthesis, modification or weighted averaging, to detemne sn 
approximste gait on a real-lirrw basts which salisiles ihe den^and 

With fee arrsngement, it becomes possibfe to gerierate a gait having an accurate stride and/or twning angle More- 
over, il wil! be possibie to corrtone and mix together two or mors starxtetti gaU to generate ar> average gait ther^e- 
tween if their conditions of boundary are the same or simitar fo each othej-. 

the arrangemertt, if becomes possitrfe to decrease the airwunt or vdume of cafcutatksn. More polrctdariy 
speaking, the amount of oateuiafion or^ the first CPU 30 wfl be reduced to 1 0%. cotwpared with a case in which tte robot 
dynamics pTot;^em is solved on a real -lime t>asis. Moreover, as the s^ropriate standard gaits are stored in advance and 
a gait is newly generated by misng two or more star^dard gaits tc^eiher, it becomes possibie to recces 8ie amoum or 
capacity of rr^eroory {the ROM 84). Furthermore, as the standard gaits can be prepared t^ttmally, if t>ecornes possible 
fo genarate easiiy, without triai and error, a new gait which satisfies the conditions 1 } to 5) mmttoned earlier. 

Figure 30 is a view, simiiat to Figure 9, bul showing the corrfiguiation of ftie system according to a second etrSsod- 
iment of the present invention. 

In the second etrtoodiment. ths system is cortttgured to have three dynamic deviation rriodeis. eontrary to the first 
antfiQdment in which Vn^ system has two modeis. 

As iliustrated in F^re 21. the b^wvior of the three models are centred suOt that modef 1 starts walldng from 
the beginning of me first waffdng st^ artd is forcibly stqsped ^ the end of ^ s«ct»id wafking step; rttodei 2 is ^rted 
ftorn Sre middie of the second wa(!<jng step and is forcitSy staffed at the end of the *ird waiting step; and model 3 
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starts from the middte of the thiwJ wafking step and is forcibiy stORi«i at the €f»d of ihe tourth wsfhtng step. The ZfJSP 
parameters of the modeis are determtned as itiustratsct m re^sonse to the above-mentioned foehavicr. 

Wijh the arranssneii. atlhot^h the tvbst befiavfor, as a wlioJe, is cootinoous <im'm mUnQ as iiJuslmied st Ihe 
bottom of Figure 3 1 , the indfviduaf nwdei 2a/!Ps are reset once per every two walking steps. As a resuit, 8ie c&icuiated 

s value is ideal reeuiSng in rx> error aceorrwlation 

in the fategoing embodiments, ttiere Is provided a system tor generating a gaii of a iegged mc^te rt^t (1) tmwtg 
at ieast a body (34) and a plurality of artfcoiatec iecs (2) each connected to the body through a }C»ni {10, 12, 14R. I], 
consprtsing gaii genera^tig mearts {first CPU 80> sets of standatti gaits, gait generation metftod determinator and gait 
n-sxer, SlO, S30, SS2) generattrtg at iea^ Ivso gaits {-istgait of ojrrent gait and £r>d gait or next gait) tor a waikiog 

w step having aS (east a paramefier relating to a displacement of the txidy and a parameter ralattn^ to a floor reaction force 
acting on the robot (ZMP); djsconlimjjty emoot?! cafcuiating nteans {fftsl CPU 80. mode! b^«cr parameter deiermi- 
nator, S30, S11 2. S200. S206) for cafculaSog an amourtt of discootiniMty of *»e dMacemsnl atxJ a vetocitjf of the body 
{Xm, Vm} and the fteor reacSon ferea {Dm) at a boundary of the ttaneratad gaHs, roodaJ input detenmining means {first 
CPU 80, ntodef behavior parameter detwn^nator. 2MP trajectory gaoeralor tor rnodet R, L. S30> Si 12. S208, SSIO) for 

1$ determining an input (sum of mode! 2MP$) to a mode! {mode! R, L) designed fo approximate a dewation o) ttie displace- 
mant and velocity oi the body relative to fi6 ftoor reaction force m response to the amount of discontinuity such that the 
mode! behaves 10 cancel the amount of discontinutty, mode! ou^ul determining means (first CPU 80, S32 to S86, Si '4, 
S116} for detemiifiing an ou^ut {sum of mode! di^iacaments) from the mode! in response to the inpuf to Sis model, 
and gait correcting means (first CPU 80, S3S) for correcting at least one of the gaits in response to the input to the 

j» modef and tiie output from the mode!. 

in the system, said gait generafing means generates fits pits based at (east on standard gaits prepared before- 
hand. A ptwraltty of the models are provided which behave to cancel the amount of disconfinaity at a dtffereot wafking 
step. The tnodei is designed as an inverted pendulum model. The system turSter includes modet ctiaractaristic storftig 
means {iirst CPU 80, ROW 84, nm 74, SW) for storing a characteristic of the otaput^rom modet r^ative to the 

i'is input to the model, and said mode! irput d^eorwiing maaos daterrrBoes the input to the nrtod^ based on the «toffid 
characteristic Ttje inpuf to the model (s designed such that the nwdsi takes a predetermined posture at an mi ot at 
least one of the gaits, in the system, said gait cts-recitng means corrects the gatt by adding the input to «te modet (sum 
of mode! ZMPs) to the floor reaction force and by adding the output from the model {sum of mode! di^lacement) to fte 
disf^acement of the body and the iioor reaction tores (sum ot mMfel ZMPs). The system Jurihes includes jotni angie 

Si; command datetrfjining means (f tei CP!J in^rse Kinematic catcuiator, S300 to S506, second CUP SS) for defer min- 
ing angi© command of the joint in response to trie corrected gait The floor reaction iotce is described in te^ms d zero 
moment point. 

It should be noted that, although the conditions of boundary are corftinuous between two wai<ing steps in the fore- 
going embodiments as shown in Figure 10 oi 3t, the invantior^ is rwt iimited to this configuration. The oondftiorrs of 

$5 twufidary can instead be continuous tor three wslKing steps or more. The boundary concfitions b« mare smooth with 
a reduced amoum of bias Ondirattng the height of the modal ZMP trap^ioid) a$ m rmi>& of watting steps 
increaee& However, the control response to ^e gait dentand would be degraded as the minrbex of waSang st^ 
increases. It is aSao possftde to configure the system such 8iat ^ boundary conditiCNis are confinuous by contfoi<«tg 
the modi^s to b«have and conv^ge to the t^ight pasitic»i in <nf irnte time 

4c It ^loutd atso be noted that, aithough the modets are ootif igured to stop once per every two waiMng steps in 
faregcing eniKXfimsnts. the models may aJtematiweiy he cwi^tgured to teke a differertt posture, ft is aftarnaSvaly possi- 
t3te to conf^ure the system such fiat Sie modeis i&ksi a pradatermined posture once per every three or four or more 
waii<iing steps, it is sti af ternatively possltje id configure fite system $Dch the modds lake a predetermined posture 
gradually wi«*i infinite time, 

4s It Should furthet be noted that, alShough the system is contoured in the tei^oirtg errtoodimenfs to have two or three 
models, it is aliernaftvef y pcssiti^a for ih6 syst^n to have four or more models. 

it shoutel furth«^ be noted ^atthe model tiajsctts'ies {wavefornts) can be stored as labirfated data. More ^etSfi- 
catly. tr»6 can be done by preparing arid storing as taoutated data the modef tr^eaories in response to the unit amount 
of trajectories during two wafking steps ard similar vaii^s in response to a unii of discontinuity at the boundary between 

50 the two wal!<fng steps. The stored tabuiated data based m the unit arrtount should then be mtJt$)Sied ar?d synthesize in 
response to the magnitudes of inpirts or ttie amount ol discontinuity. Since the tabulated <teta can nd be modified r^a- 
tlve to time, the nu(rt>er or volume of tabulated data will be mar i<ed^ iarge it Unme are many t^es of divisiwt in tie 
standard gaits. 

ft should furte be noted tot, afthough the gaa mixing ts made taased on the tee*irfique mentioned in the fir^ 
ss «itx)d!nhent of the aftiresaid earlier application, it is aiternativety possible to use another t«:hnique merged in the 
otiier embodiment of the appScatlon. The approximation technique shouW not be Med to that disclosed in the present 
invention, RaSier. various modificatfon or alteration is be possible, Forttiermore, the gaits need not be n^xed wm easdi 
omw. 
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ft shoutrf jutther De noied that, aithoitgh 8ie gart parameters concerntns accebraton {cSfsptacement accelemtion} 
?rp no- fie<=rr)b«J m*' 'wMong wiborSimerrts if is piefaabJfe neecfisss to sav to q^iifaale a mu'e snocih ga ' <{ 
ovti acccici atior ic m-^dc ccmi'iuojG as 't^c cjai fcouiwai y Smcc *iov>cvcf the accc sralio'^ is pi oport'onat to the devi 
iilicn 01 UifftterivC bcftwee't tie ZN'P atxi the booy< tt»e acceletatiOd i& not neGvJBsa'ify taken into acxnunt 
5 it shcjuld tutfrier be noted tti£3t. although the pressof mvention is described wtth reference to a biped robot, the 
present invention can foe affiled to other ieggect moble rcAwts. 

Ciaims 

io i. A system tor gaoeraling a §aft of a feggsd mc^f® roboi { 1 ) having at least a bodj* (24) and a frforafity of articufaied 
tegs (2) eacK corm€scl«i to the body through a joint (10, 1 2. L), comprising: 

gait gensrattng means {fifst CPU m, sets ot standard gaife. gaii generation method determinator and gart 
mixer. SlO, S30, S32) fef 0erter3!ing at least two gaHs {1st gait or current flalt snd 2(t6 gait or next gail) for 3 
T5 waiking sl€p havirtg at least a parameter reiafing to a dispiacemetit of the body and a paramster reiatino to a 

fioor reaaion force aairtg on the rc*)0{ 

discontinuity atrtount caicuiaSing means (firs'; CPU 80, rnodei behavior patameter determinatot. S30, S112, 
S200, for caictjiattfts an amoijnt of discontinuity of She dispiacement and a vslodty of the body fXm, Vm) 
and ffie fioor reaction force (Dm) at a boundary of She generated gaits; 
20 mode! input detemiintng means (first CPU SO, rnode! behavior parameter determinator, ZMP trajeciorj' gener- 

alCM- lor iTTOdel R. L. S30, Si 12, S208, S210) fat detefinirJit^g an sipuf {sum of rt?od8l ZMPs) to a nftod§i (modei 
R, L} desired to ^jproxlnnaf e a deviaSt»i of the displacement and veiodfy of the body feiative to the (ioor reac- 
tion force in resportse to the amouol oi diacortfirtufty such that the niodeJ behaves to cance! ttie amourrt oi dfe- 
corttfnuity; 

ss mode! outpitt determinrng means (fffst CPU 80, S32 to S36, Si U, S1 16} for determining an ou^xfl (sum of 

modai dispfacennents) Irom lire model in response to Jhe if^t tothe model; and 

gait correcting means (first CPU SO, S38} tor correcting at least cwie of the gafts m resportse to the input to the 

mode! arxi the output ftom the model. 

30 2, A system according to claim 1 , wherein saicJ gait genemfttg means genemtss the gate based at least on siatstepd 
gaits prepared betoreiTartd. 

3. A $ysiem accpfding to any of claims l or 2, wherein a plutafity o* the nwdsls are provided whieft b^ve to cancel 
the amtHinl of dtsccsttirwity at a differ^ w^Wng step, 

4. A system according to any of daims to 3, vvherein the model is designed as an inverted perrfoivim mode!. 

5. A system according to any of daiiTis i to 4. furtfier including: 

4» model diaracteristic storing mearss (first CPU 80, ROM 84, RAM 74, S14} for storing a characterisHc of itie out- 

put from the model reistive to the input to the nxsdeJ; and 

said made! input determining means determines the N^ut lo ihe model based on the stored characteristic. 

€. A system according to any of daims l to 6, V!*erein the input to the model is designed su(*i that the model tai«s a 
•45 pred^ermined posture at m end of at least cm df the gaits. 

7. A system according to any of daims 1 to 6. wherein said gat correcftng means Corrects the gait by adcfing the input 
1o the model (sum of model ZMPs) to the f tf»r reaction force and by Kidtng the output from the model {mm of 
model displacement) to the di^lacement of the body and the floor reaction force (sum of modd 2MPs). 

$0 

8. A system aiSGording to any ol clams 1 to 7. forther including: 

joint angle command detern«i^ng means (first OPU SO, wws^e kinemaSc calculator, S300 to S306, second 
CUP 82) for determining angle command of the jc«nt in response to the corrected gait. 

ss 

9. A system according to any ot claims 1 to 8. vi^ereln the tioor reaction torce is described in terms of zero rtiorn^ 
point. 
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10. A system accofrfiOB to my of datms 1 to 9, vvherein the robot is a b^ed retool 

J 1 . A method of geneiatiog s gait of a tegged mjiaite robot 0) ftaviog at feast a body (24) and a jjtoa% of articutaJed 
iegsfS) €8chconnwtad tolhebody thfoughafirsijoiniilO, 12, 14R, L) and each iiicludirsgalootconnecSedtotts 
distat end thfough a second joint f 18. 20R, L}, cotnpnsing 5he steps of; 

generating at teast tw'o gails (i st gait cj current gm ai>d Snd gai' w n6>ct gait) for a waikmg step hsving at ieasi 
parameters reiaiir^g to a dtspfacemeni arsi a vetocfty of ihe body and foot and a parameter relating to § t!oa 
reac«on force a«sng on the robot (2MP) : 

calcdating an atwunt of discortiinuily of the dispiacement and ih« vstoctly of ^ body {Xm, Vm) snd the floor 
reacSon force (Dm) at & boundary of the generated garts; 

detiermiotng m imA (sum of mod^ ZMPs) to a modei {mods^ R, L) designed to approxirrste a dwiatioo of the 
dtsptacement and the vsfocjty of the ba^ rsiatiws to »t8 f taor readtori force in response to the amount of dis- 
continuity such that the modtf behavas to canc^ the amount of discominuity ; 

determining an ooSxjt {sum d modef displacements) from ^e modeJ in response to the ti^irJ to the model; and 
con-e<3ins al Jeasl one ol 8ie gaits in response to the input to »te model and the ouJput from 8te modef. 
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